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ilT'l §0 Lf:i)*oT> ^*<7)N C co £ 7 lc . • P3 # • g iftH^Mc J: o TlQMi" 

5 ^ *■ - v -v h ^ T IX 9 7 ti ft < . ^i:7t-vn*fflv^TttlLfc^ M 

[ 0 0 7 7 ] 

* x a ifcli^v^fii*^f t 0 tl< 3 tic ioT, 2^7C7n>M H^f^5 3 
i: ^T'S & cox . Z ft £ T 2 iX 7€ ? a V -f K lc o u T t T* lc If b tit § I~I t f ffl t § 
Z t ij-* X B -5 o 
[ 0 0 7 8 ] 

f ft . fffik:*n^ftTv>S2iX7C^nv>fH%^«>"C. P3W-^ift*ftft£<7>M8!ltf>ft<6 
«tx a ^ t t£t ^. 3 i: TilT' § I. , Z <?> =k 7 ft M8U <?> ft Jjtlc o T Is] — ff2 

[ 0 0 7 9 ] 

(d) II Lco&2 

ftjkuu -ncotn^tL^Mfe-tz zhiaoT, it$5^g^ic^#ff tests :t*« 

[ 0 0 8 0 ] 

jfcfcx 7 d 7 -f F ftli: LTiSL fc^iWk:*ft^ • Jt*ft^l«l • ft*#^«liK^a ft ^ 

T4j9x ^^comm'A^ «fc 7 tc . J>bfcftT!flt4^f^4n^ -f ft ft *, . ft*ft<^^9 

> - ? S icttffc L T . (7) , (20) JkV (26) sUc^-f «k 7 tc . ft^^ft^^. ft^ib'fi. 

m©lCJ|<^^ftSo c <7> c fc l±. ^iE-tS S(ft§iJffl T^jtlc B £>dt>xifM z 

cozt\z£->x. ±m\z$j-Mmm^mm l . > t -ft ir-^w^^m^-ts z t . 

[ 0 0 8 1 ] 

N C Tjn X ic ft o t . II MiWco m.'h ft S t± * ^ ft ^ S T- *> ») . x 7' ^ >f > ffl n ft 
T 14 Z ft * db -5 <7> tc ffl i J ft ff S * g i" -5 . ^ n V >f H T* 14 — ^ \z -b r > > h Z h\zWt 



[ 0 0 8 2 ] 

( e ) mmmw *) s 

fifflts 3 tic J: oT, ftnX fFfl<7> ^il m & z t § £ . S3sll^**fy 
T>3ffitfcttSf t L T 4- <b ft. i2S • ftnji mitmU^^] iztt L T <b ft -5 . 

Mt^fff wl't^Ig t §^ ic h ft. MWlWi&tzfc c tzMW^^f i z t 

(6) ii^)4^t§^-7 
^iftk: «k tit* 3 iX7C ^ n v 4 h ffiiji^^-^ ^ > - ? j^ftjjfcic&Bri-^SiiJitT^ 33 0 
§ ^ ^ > - ? -5 c t iz <k o T 13 4 <?) =k 7 iz 3 )X7C ? a V >f K ft Jjfc*£j&-* 

^1 It. 3 iX7C ^ n v >f Hft»^§^'7 > - 9 <t>1£H % * t db tz t <^ T £> 5 « 
[ 0 0 8 3 ] 

im 1 ] 







Po 




h 




ao, bo 




ai, a2, bi, 
b 2 





[ 0 0 8 4 ] 

2 . 3 }X ^ ? n v ^ K ft &§uc J: £ M v£ 
( 1 ) v#<b fc^fi M<7>gt^&^tt 

tc ± £ X m to MMffl W * ± & B © t L T . 3^7t^o vn*fti ( 3 YK tz 9 v 7 >f h -b r 
> > h ) ^itft^tiM L . 3 <^®C*<7> 3 ? a y -i K -fe r > > h [C J: o TII^II 

* flj 9P "t § . 
[ 0 0 8 5 ] 

2 *<7) 3 YKJt ?nV^H ft tf> 5ft j& T vt <b *Mcfiic2 tlTv^ § d i: & . Jftj&feg. 

tg j: ummfrMffiizmffiz tiTv^ set t %.m$ nz* ±.&<r> m\>>x 

[ 0 0 8 6 ] 



[S22] 



Py l (D = Py M (0) 

Pz,(l) = Pz M {0) 

a,(l) = a 1+I (0) (26) 

A0) = A + ,<0) 

tanr ; a) = tanv, +] (0) 
jc,(1) = * 1+i (0) 

[ 0 0 8 7 ] 

[ 0 0 8 8 ] 
[S2 3] 

/» J f l (l) = ftr f+1 (0) 
Py i (l) = J Py I+1 (0) 
/>z,(l) = />z, M (0) 

cos[a,(l)-a, +1 (0)1 = 1 (27) 
cos[#(l)-/?, +1 (0)] = l 
tan7 / (l) = tany (+ ,(0) 
*-,(1) = k-, +1 (0) 
[ 0 0 8 9 ] 

[ 0 0 9 0 ] 
[S2 4] 

cos[a,.(l)-a l+1 (0)] = l 

[ 0 0 9 1 ] 

T'i>5: i: ^ % M. \z ti £ t 
[ 0 0 9 2 ] 

im 2 5 ] 

tany,(l) = tan ?,„(()) 
[ 0 0 9 3 ] 

[ 0 0 9 4 ] 
[it 2 6 ] 

tany,(l) = tany (tl (0) 

g',(1) _ ^,(0) 
/?',(l)cosa,(l) /y /+1 (0)cosor J+I (0) 
v «',(1)^ 1 (0) = « , ,. 1 (0)/?',(1) 
[ 0 0 9 5 ] 



[ 0 0 9 6 ] 
[12 7] 

Pz,(\) = Pz ll] (0) 

cos[a,(l)-a, +1 (0)] = l (28) 
cos[/?,(l)-A + ,(0)] = l 
a'MflAO) = < tl (0)A'(l) 
/r i (l) = /r /+1 (0) 

[ 0 0 9 7 ] 

(28) 5Uc*fV*-e . 11]^ 3 jUiteH^y^tt. <X<^ 2 ^liff ifeft^laJ^nlifro'ft. tfC^l^ 
2*^3i^7C^ny ^ H ft *fc fc* * 31/3 T (28) 5^ 7 o ^> & # 5^ * if "t -5 

o 

[ 0 0 9 8 ] 

G 2 jIM ( G aGeometry<7)fl3C^) icooTffi^t^. El 5 It G 2 £ ffi RB ^ * ft % 
[ 0 0 9 9 ] 

G 0 Mm tit 2 ^f<?> 3 Kit ^o'/U* ffiJfelfc** ^iW^Tfiia** — Set § G 
1 il^i: «m*l^|Sl**-Sc-tS 3 fcv>v>. G 2 feffit lilfttfffl (^«Q 

n V >f K ftiffflv^ *i£ G 0 - G 2 Mm b^tttt-fZ* 
[0100] 
[ft2] 





G°:#g 








G 2 :i|gftfe¥®(ifei&h ft^ 



[0101] 

2 *<7) 3 YKit ?n'^F ftH^ilfectt^: #x. i: § ic . C 0 — C 1 — C 2 . G 0 — G 1 
— G 2 IC £5 IC Lfci)^ Tfflffl^frft'JK L < C 1 iHSST 14 Jtijfctf) * § $ t 7a ft - 

Sc-t £'.&Sfc*£><5 *** G 1 mm-Z*l$mWtJ3fatzrtfr — $t-tiil$ J; 2*^)3iX7t^ny 

-7 7 >f > ft*ft<^ «fc 7 lc C 1 mmX'^kf¥x^^W^ 5 £ . lc u if <«*>:*: 

i^^Stitv^^fr^Ai^T, ^fr^tU^nfS. G 1 mmx°$kf¥j$-$:ft 
J&~tZ £ . -YKmfr&%£to±Z 2^U&\z£iiZ> £ 7 *!J 
[0102] 

G 2 3l^Tttf#«¥ffl (?£«Q i±^o f#W¥ffii: 14 HI 6 \z ^ 2 ti h «fc 7 lcft*| 

c **^pff ® tc# * n« ¥® s i , s2^o?. z <?) m 6 x> it & p iz ss \^ x mujj fa fr s mm 

Sic. tf^7af«]^ — $:<otfac SrlttUf 3 £ l4Jf^¥ffl<50 — SC"?*>S. ffi^^ 

Wktm-f Z> £ B iz l4fSft*¥ffiib* — SC Ltu^u fc^i**** < . ft fit ¥ ffl £ — St 3 -t±/c±.Tffi 
*S'J^^***>S. 2 3 iX7cft*fcT. Mil. m*t7jf«K ittfffl (v£&t7aft 
) ^Vffi$$-K^€5C^»G 2 3I^ilf /ill-* frtc&£ 0 
[0103] 

( 2 ) mfctotn^n^m 



[0104] 

(a) $im<r>'* 7 > - 9 h, a . P %5-Z.X . 1*^) 3 /Xtc h' ^ <r> 
m&TZ . (28) it^i/it «k 7 lzYK<?>tYK7t ? a V -f K ft Jjft <7> ' * ^ > - 9 ^mdb& . 3 ^ J: 
7 t L T > ❖ t vt'b WcJI^i" £ 3 /tXtu 9 a V >f H ft*t^f££ ^T* § -5 . 3 
<*>ff S^IWlc «k ft<*>< 7 > - 9 toMiti \$&%X3b *) . zn-&MMtufr&o zcdJjiK 
\z Jctiii, ti * £0tK<7>ft*ft%S^K:2&£-e3 § fc*. ft^^fflii-t-SJi^c^^BH^^ic^ 

[0105] 

(b) ^abffi£3ttfcj&g¥**ft*ft<?>if «k 7 ic. 3 ^tu ?ov^F ft*ft*J$ii§ci- 

fti (^n-M h'^^>>h) tf^tS. C<7>jf^cii. (28) 5*%Sffc-* J: 7 tc ft*ft>< 
^ > - 7 § l+m^HUti (a) «k I* •? MURIUM t~&Z> 0 z ^t\M 

#JK* . Jf M£ i# left 7>-HS^t^ ti^:!:^^ j^^tDf^o 

[0106] 

[0107] 

* £0 7 > — 9 : ft 7 t — 9 
Jq/^^fr : (28)5*. £>£Wi*<7>-g& 

WJJE-t* *^nft*ft^ v > - ? % it ^-*<&g 
[0108] 

U^^tWC^Mrt. *R5fc£51#> £ fzdt>\z. ^7 > - 7 ic o v^T «k 9 ^v^JWffi ^^Si" 
[0109] 

£ «k "7 icfflffl Lfc&T?. 12 STEP i: L T l»] * -gCi" S «k 7 tcfflPiB^tf v^. S3 

sTEPTft^t-sc-f s * 7 icisra-f £o c <7>^^<^atti^«t^* 0 7 \zm-f* ^^tn 

3 )X7C f a v >f H ft*I^^V^<7)Jtifix rtm*? feMiKltUlz ^ L fc. 

[01 10] 

( 3 ) 3/7V7C ?nvn' ft*ft*fflv> fcffi^vScO^Sfe^lJ 
(a) fflravS^5Hti 

3 /tXtc ^ n v ^ K ftM^fflv^T 4 x h il tz £J\\ <r> m ^ m h ^tcfflP^ LTu < ^^comm 
fJtcov^Tl^L < 3 )X7U ^ a V >f H ft*ft* ffl v^fcffi «>i * Wl^ , 3 iX7C ^ n V >f 

K 1in t 0 4i 0 ffl \z J: o T 5 tl -5 ft*ftfflf^*% 3 )X7C ^ n V >f K ftJfft i: Df V. * *i 
^li^i" ^tfeftit 3 /7V7U 9 a V >f h'tr>>h fc Df 
[0111] 

3 7C ^ a v 4 H H n ifttl t L X It . ffim*t%i<7>)&m-&ffi&Sfc7tt W 4 K 

■fe r > > h ^§^'7 > - 7 ^*^JS( fc L . JKStcfflWWm^^^ia 0 . 2 3l^i: * 

%4kflr-&ffirz'tffi-&-^ - h > • 7 7° V >&T«:d<36Tft^£fi&i-So - <7> Witt <D 



[01 12] 

( b ) g 2 mifc%nm<7>3kft 

[01 13] 

4-. ffl^lcSo^^P^I Pxj, Pyp P z i } , P2=( P x 2 • P y 2 * Pz 2 } ' p 3 ={ Px 3' Py 3' Pz 3 
<?■ <50^^3iX7C * n V >f K -b r > > H TffiWtS 3 t * 3 . 0 9tt^Pi. P 2 
. P 3 ^3)X7U * a v >f K mm^^-fo j&Pj, P 2 M%^^ft*ft*tt*ftC 1 . ^P 2 ' p 3^^*S^ 
ttI^ftlt 2 i:tSi:, Z*>jg£-**n$Ctt. ft*ftCi<7>^ ^ > - 9 aOp alp a2j. bOj-blj 
, b 2 1 , hj. ffiHC 2 <7>^ "? > - ? a0 2 , al 2 , a2 2 , b 0 2 • b 1 2 » b2 2' h 2^ 1 4flIt ^ * * • * ^ 

[01 14] 

lc fcv^T ttjftfBlcfctWjN- t ^fr tt3iX7C * n V -f H ft *ft <?> ^ » <b 
£ i: . ^n^^4- x/c^^T^^SJtca^^ ft S T ffi IB & fHi & 0 ^tcmiw^PjTlifi 
IICOUT30, Jf n'McouT2o, ft * 31 Irc <?> * # <?> x^^iz B £ i: ^ ft lc o 
T 2o^^H7I^ > )io 0 Sfc^^lcoi^tt, j&P2~?tt-aiBlcov*T3o<7>3fl9-??#><5 

fri g£ i$( ^ V L < L fc. zmmii fa* ft fe-fiilZ a 0 ! . bOjli. ^-<^/^« 

< . 

[01 15] 

Ui\ teg<7>*frlc ov^T £ i: . (1-1) (1-2) (1-3) ^ £ 9 x Tie<^ 3 o <?> 0 

[01 16] 
[S2 8] 



Px, +h, ^cos(aQ l +al l S + a2 l S 2 )cos(bO i +b\,S+b2 i S 2 )dS-Px l+] =0 (1-1) 

Py, + h,^ cos(a 0, + al, S + a2, S 2 ) sin(60, + M, S + M, S 2 )c/S - = 0 ( 1 - 2 ) 

Pz t +h, ^(-sm(a0, +a\,S + a2 l S 2 ))dS-Pz i+l = 0 (1-3) 
[01 17] 

iXtx Jt*ft^|S|lcov^T#^.-6 (1-4) (1-5) w2"3Wjti)^!)jiT ( 
[01 18] 
[if 2 9 ] 

costaO, + a\ , + a2, - a0 (>1 ) = 1 ( 1 - 4 ) 

cos(M) # . +61, +62,-A0 1+1 ) = l (1-5) 
[01 19] 

[0120] 



[S3 0] 



K-,(l)-*-, + ] (0) = 0 



(1-6) 



[0121] 

( 2 1 ) it H $ ft -5. c 
[0122] 

^o^tiT*^, mmmmufa ci.o.o) tctttx. ^iw&*&7jft^$c y ^m^x co, 

cosr.-siny) T-itUS. 3 ft * ^ TO C «k l ic 0 K $ i± £ t * v£*t n it ( 1 -7) 

[0123] 
[K31] 



coso , ( t S') 0 sina^S*) 

0 1 0 

-s\na(S) 0 cosa(S) 



cos /?(&') - sin /?(S) 0 
sin 0(S) cos/?(S) 0 
0 0 1 

— sin y cos J3{S) sin or (5) - cos y sin /?(«S) 

- sin y sin sin e^S 1 ) + cos y cos 

-sin ycosa{S) 



0 

cosy 
-sin y 



(1-7) 



[0124] 

(21) ( 1-7) i: x siny , cosyti (1-8) ittc ftm L T 3 t £> £ 



[0125] 
[K3 2] 

s'my — 



a'(S) 



cosy 



*Ja'(S) 2 +P'(S) 2 cos 2 a(S) 
/?'(S)cos«(5) 



ja'(S) 2 + p\Sf cos 2 
[0126] 

o * »> x it (1-8) «k *) . 3^tl * n vM H 
l± t an y ilijroT ft ti J: u c i: in* t> £ 



(1-8) 



[0127] 
[K3 3] 



tan / = 



0\S)cosa(S) 



(1-9) 



[0128] 



:T' £> £ * # l± x it ( 1 - 10) T« *> § d fc 3b* *3 Z 



[0129] 



[S34] 



tan/,0) = tan/ /+1 (0) 



(1-10) 



[0130] 

: : T'^ b ic > 
[0131] 
[S3 5] 



cos[«,(l)-a, +l (0)] = l 



(111) 



[0132] 

T*3bZ> C t &%m\Z\->fLZ> t^fr^ (1-10) It. Tie^^fri^ (1-12) h tl£o o 

* 0 . S HiIMT* * § & ft li ( 1 - 1 2) 5^ T 3h § . 



ti 5^ ( 1 - 1 3 ) <n £ 7 lc5r § c i: ^ ^ £ . %tz , - lz T & 3 ii h <r> 7 *> co \^ < 

[0135] 
[K3 7] 

Px,(l) = />x, +] (0) 
^,(l) = i> (+1 (0) 
/>z,(l) = Pz, +1 (0) 

cos[«,a)-^ + ,(0)] = l (1-13) 
cos[/7 ( (l)-/? 1+1 (0)] = ] 

«;(i)^,(o)=«; +1 (o)/y;(i) 

A-,(l) = /f /+1 (0) 

[0136] 

&±<fc »K ^^afCalp a2p blp b2j- hp a0 2 - a 1 2 • a 2 2 > b0 2 ' b 1 2 » b 2 2 • h 2 <^> 1 2 YIH 
% a 1 . |9 3 t S . ) 



[0133] 
[K36] 



(D^, + , (0) = a', + , (0)/?', (1) 



(1-12) 



[0134] 



[0137] 



[13 8] 



/VD = />* 2 (0) 
Py l (\) = Py 2 (0) 
Pz ] (]) = Pz 2 (0) 
cos[«,(l)-a 2 (0)] = l 
cos[/?,(l)-/? 2 (0)] = l 
a',(l)/?' 2 (0) = a',(0)j3' 2 (l) 

(1-14) 

/f,(l) = «r 2 (0) 
/*r 2 (l) = 7*v 3 (0) 
Py 2 (l) = 7^,(0) 
Pz 2 (l) = />z 3 (0) 
cos[er 2 (l)-# 3 ] = 1 
cos[/7 2 (l)-/? 3 ] = l 

[0138] 

3 tlT * fcl 1 2IlCov^T 1 2i«iti!) 1 ^ , )io^T-»ttft§C i:^T*§§. 3 tl 
[01393 

»i*i<ni:S£«-ttitt J:v>. **ol t *#^<7>1<t> PUS?* * . 
[0140] 

m *. It n- 1 M <ry & m § i: £ . NM <?"> * fti 1 i: N ffl <r> W ^ 9 o t i" £ . ;;X' 
5 ^ IC l^it^fe fct^t, **a$U2 3 #(7U 2 a V >f K -b r > > h P n _j, P n <?) ?BV>fH 
7>-?aO n , al n , a2 n , bO n , bl n . b2 r h n <?> 7 o fc* if £ -5 „ — TjT*. ^ff-i^ti. fflw 

ft 3g 31 2 h^frlcov^T 2 oc^^ff 7 oJt*.£. 

[0141] 

n = 3Til*ftlf(, n «fc lc 1 2 AS T § 3 t fc* ;b fc> o T o S ^ «b . n > 3 T* . * 

*n & li 7 (n-2) + 5 ill. 3ttlC;ttLTi£ , )3:o;j$<t7 ( n - 2 ) + 5i*>^„ 3ft-? 

8C t * ft ic n -t s & <?> 8C L <^§^)T\ nM^ B & j&fll <?> if 1 if t |b] 
tif^^a-?»%^*>sctl()*ir^**. Kf^fcLTli, *£nl t &ft^<7>m\z it (1-15 
) (1-16) ^,<r) m b*f& *) ja o 3 h * ft ffl L - - b y • 77'v>ii^fflv^Tffufc. 

[0142] 
[13 9] 



AF = [j]a« (1-15) 
Aw = [■/]"' AF (1-16) 
[0143] 

[0144] 

(c)IM^)^ 

- a. - h > - 7 7' v > vJ ic 4? u T tt . ffi <r> * ft to * l£ k: 31 ^ £ #JJW M * S 



o u X t£ ^ -S o 
[0145] 

5feff fiff^T*£> 3 3D Discrete Clothoid Splinesti, M^\z mmttMl&^M *) . 

3 #C 7U ? n V -f H n m <?"> tz db co m m ft % . Ell 0 ^ <k 7 * r = 4 3 D Discrete Clothoid S 
p 1 ines<7) # 'i =f > Q^fF 9 . ^ 3 ^bl+ST'^/ILto 
[0146] 

Discrete Clothoid Sp 1 i n e s \Z o T ffi&S£HJ! ~f £ . HI 1 \Z ^ $ ft * J: 7 IC 
fflMW^M^Mfcti^iF*^'), P<t>& Uriels] ctrlo'olffc^ 

'J ^>QliHI i: -o-T-rnM. iv^Tv^f^Tr (n-1) +HS^TM^^^ o 3 t tc * 5 

o lil^^ "7* * ') 7' h fc*&j&fc><b<7>ai LSf i: LT . ^-TR^^ Q i xm~t Z t \Z ~f £ . tLtz 

. &m£jzte^x. nfa t Lx'&mm-< ? h ;n>%. $ t ua* * %jfo * 7 

9 h >H[ * ^ #> S . 
[0147] 

Tie<50H^lB]±**^giItttc 4 § «k 7 ( 1 -17)fcs5fcL. ft^**46^*^ 
<r> ^mwm\z it M -f S J: 7 tf^tftftfcjfi < i: § ^ 1 - 1 8) <^ W ft* fti" S 

t £ co ) * "J rf > Q % 3D Discrete Clothoid S p 1 i n e s t W 7 . 
[0148] 
[K40] 

|qi-.qi| = |q i+ .q,|- (q,«P) (1-17) 

XK^.H 2 . i = {0...n-l}, A 2 *, -2*, (1-18) 

i = l 

[0149] 

3D Discrete Clothoid S p 1 i n e s T* li § TH <?> I* ^Sl^tTMc^i f CT' 

. ^<7>#--(£Jtifi^|Sl^ ? h >v t «k 9 ^ ^ > - 9 a o • b 0 ^^<s6£o 3 *>J£*ft:fr6J ^ ? h ^ 
t l±# ') =f>Q£ i: § tci-T'lcgXfr] 3 <7> t i: 3 )X it 9 u V -i K tt *l tf> 

Jt*ft*>j* i: «fc 9 . # =fy Q<7> TM^<7) tf ^ 0 15 ft a . (9 t)*$< £ £ . 3 ftlc «k 0 
<7>a 0 , bo^^KHMfc*^ £ 3 o * * 3)X7U ? a v >f H mfrlzis^X It. % 

cr> M ^ x. -5 o 
[0150] 
[14 1] 



u 



cos /? cos or 
sin (3 cos a 
-sin or 



(119) 



[0151] 

:ZT\ 3D Discrete Clothoid Splinestt. TI^ ib* VWM \z M ^ T* c t ^ # ^ £ 
. 13 1 0 <JO ^ a 4 j |i T li x tt*ft^^»S**l/4T?*>S tfifW-r^ 3 i: ft'Tf§ [s] tl lc ^ g 4 ( 

[0152] 



[S42] 



(1 -20) 



[0153] 

3 li**n£tfc*a 1 4 j a 2 4 j <?> 2#C7U3l jaTjH^ iz t£ ■? X 3s *) . z j#v* X ^ => > - 
yap a 2 ^«Sf?fi -t -5 o IBJtiUc ^ 7 > - ? bp b 2 ^IOSfl« t ifc^T § £ . 
[0154] 

[0155] 
[143] 



r (1-20 



cos 2 or 



[0156] 

i: 5^ (1-22) left 0 . h*>#J»lfft **v£S $ ti & . 

[0157] 
[14 4] 

, V(fl1 4 / + 2^2 4 , ) 2 + (frl 4 , + 262 4 ,) 2 c os 2 (a0 4 . + al„ + a2,„) 

«4, = (1-22) 

*4(l + l) 

[0158] 

o c: L£2J]BH«£ffl^ (b)TiB-<fc J: 7 ft0 2 ai^t ft £ «fc 7 4*ftTT'§ffii^o^ 

[0159] 

mmizu±.izft-<rz^yi;X}£mitmm tr^m t lt (o. o. o.o, o.o), (2.0, 2.0, 2. 0) 

, (4.0, 0.0, 1.0). (5.0, 0.0, 2. 0)<*>4j&*3iX7C* n V >f KffilW Lfcfllfc^l-f*. fc&W 
tc J: 9£j£3*ifc3iX7G*nv Kft*ft<*>2S&EI%l3 1 2 tc ft i± . m 1 2 li H Jjft 3 iX 7C 

[0160] 

$ «b tc n 3 tc #tt*6<7> ^ > - ? * . ifci4K, §ii^T-^)ii • mm ■ • ft 

m<n-fft-&Wiitti. zfih «k 9 ^miw^TG 2 !!!^^ ft 5 J: 7 ft3^7C ?nvn* 
^^tiTv^c h**bi)^„ m 1 3 t±fflttk:46^*^<^#iftK|l||. Mile ft 3* £ IX 

ofci$t£^77T'*^„ 
[0161] 



[ft 3] 



a = -0.657549 - 1.05303S + 1.84584S 2 
/7 = 1.03297 +1.29172S -2.551 18S 2 
h = 3.82679 
P 0 = (0.,0.,0.) 

a = 0.135559 + 2.18537S - 2.69871S 2 
/? - -0.226655 - 3.15603S + 3.03298S 2 
h - 3.16932 
P 0 = (2.,2.,2.) 

a = -0.377569 - 1.45922S + 0.984945S 2 
0 = -0.349942 + 1.32198S - 0.873267S 2 
h = 1.43987 
P 0 = (4.,0,l.) 

[0162] 

Coord : (1 .16 x 10" 5 ,2.00 x 10\3.82 x 10" 6 ) 
Tvector : (7.59 x 10 s ,1.50 x 10- 5 ,2.95 x 10" 4 ) 
Nvector : (2.93 xl0" 4 ,9.19xl0" 5 ,-7.57 x 10 6 ) 
Curvature : 3.06 x 10' 7 

Coord : (-4.33 x 10 6 ,-1 .64 x 10 s , 1 . 1 1 x 10' 5 ) 
Tvector : (2.06 xlO" 6 ,2.33 xlO" 4 , 1.97 x 10" 4 ) 
Nvector : (3 .3 0 x 1 0 4 , 1 . 1 9 x 1 0 5 , -3 .23 x 1 0 5 ) 
Curvature :5.96xl0" 6 

[0163] 

( 4 ) mtitlztsl-t Z &ii.<r>fflffl-& tz G 2 llic& 3 )%1t ?nvn*ffil 

(a)*iW£ft h^fa®. 

(3) Ti^fcJ:?!:, mmb*mv^Tv^ ZM^T-ffimttMl^&^nmJhZ b B , £Ml£\\- 

icouT **n&& a 0 . aj, a 2 > b 0 , bp b 2 > h<7> 7 o £ T* . * £n & it 7 (n- 1 ) M 

£ c i: ic & £ 0 — 7?. *f4^tc o ti . n-2M#> * tfM^ r t iz mm . Jf*SU ft 
2£c7>7M-^o fc&j&k: felt 5 J^j£*>3M*>*t¥&-* ^g^T-7 (n-2) +3M"?£> £ , 2 - 3 <7) 



^mxit zinz^^ • %&&jzssrt z>mm-< ? h ^-zh-z.. u^m^-t z t tc * ^x 

[0164] 

• m&izssrtzmm • mm • mm* mm t . ^^^mmt ft& & 7 te^ra 

f * «b . ttM^lCfelt-SfflS^iilffl LfctlJ: it^Ts 2 ^ tcM • i^T'SI • 
ffi2fnc ov^T2Mo*o fHMif££ 3 t tcftS, -f&b, ^kftxt ti^g£T* 7n-3M h 1^7 
3 i: tc 4- 5 . 3 <7> if . * ft] & co R ft* ^ # J: 9 /> ft < ft § a6 N - ^ - h > • => -7' V > vS 
"C)»%^ftSCi:liT?S*v^ *<7>fzdb. t£ hfr cortex* ^fa^-km*? -f>&m& 3b Z> <> 
[0165] 

fL<t§Ci:lcL/:. fll ti\ 4 o * ft] $(<7> 7l7 fc*^u<7> T* * tl . ff fti&l: 2 o |? A L 
[0166] 

o* o (?) 1 4 M it £ -5 o -^T\ * ft] m. It 3 tc ? a y >f K B. 9s- fc* 2 o if £ -5 <^ X . a 0 , a j , a 2 
, b 0 , bp b 2 , h<^7oo*o<7>^tH4ffl<^*fr&fc*ii;i5 3 t tc ft £ <, 3 <?) i: § ?U tc # £ 
tt5/&<7>$Uin + 2ffl?*> § *o . ^#T- * 3 i: *ft] » It 7 (n + 1 ) M . * ft 5* 7 (n + 1 ) +4 M 
t v^7 z t lefts. CCT^^IC, Sf 7ctcjf A t fc^<7)Jffi1g<7> 7 *» 2o^*^it h LTf# 
ntit, *ft]f(tt 4oifx. 5 3 t tc ft £ . fSt, **n&*,&# 7 (n + 2) -3flS t ft 
Ox *ft]it<^fW^*a6 § 3 t h*x § -5 J; 7 tc ft § . 3 <r> & 7 tc ff ft 4? At § 3 i: tc 

SIB* ft 7 3 i: ^Hj^tc ft § . 
[0167] 

ftiJPi-S it^lCov^T^ffi At5^^)S t * <7>^JC 4? v^T **n& t LTftl M^<^i(tCo 

= H> jKIBlc§^*aiS55:^S-3iX7C^n y >f Hifi^lc:ov>T**DSct±ao. aj. a 2 . b 0 > 
bp b 2 . h<?>7o*»s<7)-z?. *ftJ^Cti^#T*7 (n-1) S 3 i: tc ft * . — ^f^^tco 
v^Tti. n-2I*^i^r i: tcj^lg, Jtifift. ft ^5 <^ 7 ffl o 1 14,^ tc tt * M ^ 

3M**i¥fci-S<50T*. ^g|5T-7 (n-2) UiTJ* 0 . *ftit^)^*Mo^^v\ o * 0 . 
fev^TftOP $ 3ft3 ^ § Jl g ti4oiii_h 7 3 i: tc ft § . JJIT> IfeB^ + Tmtt 4 Jil _h<?) S ^ 

[0168] 

(i) m=2k<7)tS 

M^3T*>3b4±Tra=2kffl<7>Jl@ ^iJiP-tS i: § . * *n ®. It 7 (n- 1 ) M . *fr^ti^fr 

T*?(n-l)-4 + 2klT , 3f>§, 3 <J0 i: B jfiKI ft ^ ft 5^ ti 2 k-4lT' * . k-2M<?>^^: if tc tc 

J? At-5 3 t * . 3iX7C^ n y >f H Jj6^*»k-2*x JfM^ **k-2fflii x * <r> T- . * 

ftiS(tt^#T7 (n + k-3) *ft^ti^#T-7 (n + k-3) -4 + 2 kfi i: ft * . 3 3 T* $ ^> tc Sf tc 
If A L tL&&<r>m%k<n\%<n 7 *>2o (iitfLj) LTtti tt5 i:, ^ftiStti 

^#T«7 (n + k-3) +2 (k-2) fl. *ft^ti^f*T-7 (n + k-3) +2 (k-2) fi t ft 0 * ft] i: * xK <r> Be 
3b*# L < ft -5 o 
[0169] 

(ii) m=2k+l<7> i: 8 

M^T-*>^1±Tiii=2k+lM^Jl@^ftlJP-t-5 t § . *ftif(tt^f+T7 (n-1) fS. *fritt±^ 
f*T-7 (n-l)+2k-3MT-£>£o 3 <^ i: § ft$J ft^ft^ ti 2k-3MT?«> -5 . 4-. k-lfi<^^^ff 
tc4f A~t Z 3 i: % % t . oYKit ? c y h'i^ii'l-l^, Jfj^^C >t>*k- 1 M±i ^. * <r> X' . 
*ftJ^Cti^#T7 (n + k-2) ti^#T« 7 (n + k-2) -3 + 2kf® i: ft * . 3 3 X £ <b tc *f Tz 

\zW AL tz&&^mM^i&^ 7 *»2o (#ijxtix,y) §**D»fcLTj»7 kt« fc, *fti^ 
ti^#T«7 (n + k-2 ) + 2 (k-2)I, *fritti^#T'7 (n + k-2) +2k-3fi t ft 0 *ftit<^i(^lo# 



< & £ . f :T\ m=2 k+ 1 co M q- iz A L fc;&<7> 7 ia t o <?> ^ ic 4? T li <?> ft <?> 7 
*,lorilt^*^ii: LT»7 f 7t^:tt\ **n$Cli^#T-7 (n + k-2)+2 (k-2) 

Ms (n + k-2) +2 (k-2) ffl t & *) **oic ^fr5^iC^V L < 

[0170] 

Mate £com *<^lg^T^*fr&fc£fr^<7>&£#>;b'e<5 z t ^t-§ . ma&±.mxft&<7>& 

ft ^ Mm -t Z Z £ <)'T'§ 5 . * . ft| 9P JI B i: * *n $C . ^ttit^ilcov^i^fctw 

^ ft 5 tc is -? o 

[0171] 
[115] 











if x.5 


4 


0 


0 


0 


0 


5 


1 


l 


l 


1 


6 


2 


l 


2 


2 


7 


3 


2 


1 e<E>J& : 2 
1 m<D& : 1 


3 


• 


2k 


2k-4 


k-2 


k-2 B<DM. : 2 


2k-4 


2k+l 


2k-3 


k-1 


k-2 : 2 
1 fiO^ : 1 


2k-3 



[0172] 

(b)^v£ 

M • ^^T&fi^ftUil-t 5 VAvt 9 a v ^ K *ffl^fcffiWY£tt , 014 SVS 1 5 \Z 
^$Tl& =k 7 tc lii. T tf> WE ti T- tf ti -5 o 
[0173] 

[0174] 

Step 2) tifcft*ft±K:*f fc*J^*ff A L . *f4^t**nS(<7>S^iiSgi)-£ 0 

[0175] 

StepS) comm^^ * - 7%#lJWffifc L T x B ^<^*fr^iiSfci- J: 7 £ & ft *6 tf> > < 5 > 
[0176] 

WT, ^Steplc o o T s& Bfl^ ffi £ -t 5 . u -fstep 1 lc fcv^T ti . JfJjft^ - ft * & <jo 

Tt. -f-^flifS^^^ > - ? ^#>£ ^3>]«JJft £ LTIi> (3)^^vSt[B]CinWft^ffl 
[0177] 

iX S t e p 2 ic 4? X m tz & ff A L . *ft t **Q8c<z>8t<*>HB£*fr 7 3 £ \z & S . 3 

S 0 iJfcx }f ns^k LTl±ffiW*t£jM±**S.&SteDlT£ifc3 iifc3iX7C ^ a V >f 
K*ft^^^ra<^>^^f¥ A Lfe. $^lc. f¥A^ tiS^ttWSH^^IK tr \zW A Uv^ < 



[0178] 

m.'& IZ S t e p 3 \Z o T *> * ;b* s S t e p 3 T ff 7 — ~ - h > • ^ 7° 7 > £: aft <5D 30 ^ 

**fflv^S. Jil_hT*. Step3tcfclt 3 ftJj*<7>&>< ^ > - 57 <^fj^f(^^^ L fc. c<7>#]JtH 
ft £ m v> T . - ~ - h > • ^ 7° y > >S \z J: o T # h fl tz *y > - 5^ ft* £> 3)X7U ? a V >f H 

o 

[0179] 

(0 srafj 

^mizWHQXcomm. Si, M^ft 6 ^)*ftTiit§ «k 7 tc3#C7U * a v KfctW 
[0180] 

im e ] 





mm 






mm 


p, 


(0, 0, 0) 


(Cos( G ), Sin( 0 ) 
,0 ) 


(-Sin( 0 ) , Cos ( 
0 ), 0 ) 


0. 2 


p 2 


(4,-4,- 
4) 








p 3 


(8,-4,- 
5) 


(1,0,0) 


(0,-1,0) 


0. 2 



[0181] 

fc. mi 7ic[3i 6 *>ft<«*>iiM**tJ£<* j erz&mm<7> i &}&fr>b<7>3M$m t mm<?>m& 

^^7 7^fet 0 £ f£ $ tl ft m. It . $k 7 h £> fc* £ =k 7 lc ^. tz * fF * H tz L T £ d 
[0182] 

[i7] 



^^fcia^fiK^fciftiftw*&jfe-»^©S!j». sift. ft*©^ 











Mm 


p. 




{0.0, 0.0, 0.0} 


{0. 8660, -0. 5, 
0. 0} 


{0. 5, 0. 8660, 0. 0} 


0. 20 






{0. 0, 0. 0, 0. 0} 


{0.8660, -0.5, 
0. 0} 


{0.5000, 0.8660, 0.0} 


0. 20 






{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{8.0, -4.0, 
-5. 0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 20 






{8.0, -4.0, 
-5. 0} 


{1. 0, 0. 0 , 0. 0} 


{0.0, -1.0, 0.0} 


0. 20 




H 


{0. 0, 0. 0, 0. 0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 



[0183] 

(d) * m&x-<7>i$.<r>mm 

(b) <7>^m\z * . m^fciztsi-t z&m-zmwL^^ . Omm^mm^'ij z. & «* 7 ic * 

ot. ;:t\ MJQ^t- ft < + HU;£uc 4? x fi * ftl P -t * if □ \z o u t % z. z> . 

[0 1 8 4] 

m -t s - t -k % z. & o l^l, 4- * t- ^ ^ t § £ ^ v£ -? it 4> m ^ tc is it * « * m m -t & z 

t it X § ft . f c z t- 3 <7) ;±c#J % 2 o tc 5> it £ 3 t tc «k o T 45 m <?> ft * ftl 

[0 1 8 5] 

•t%t>*>. &m\ztt Lx-mizmm^n 1 ^xita < . ^m^f^m^x^m^t^^ 
izfrrtxffim-ziT 1 o c \t. m&\z&rzz z t \z%z<dx w<r>^m^m^fi 

ttt^iitsc t fc* X § £ «k 7 tc ft § . 
[0186] 

3 <J0 J: 7 tCffeiJi] LfcvMfi<*>*>*;&-?E#*$H+. * W *| K: felt £ fft ^$0ffl LTfcSW L 
[0187] 

( 5 ) mm&x^mm. mm. mm^mm l £ 3 ^tu * n v >r h raw 
m • m-£Lx&i$.&mw-t & vatz ? n v >f k %fflv^«im^tt, mi 9ic^£*isw 
(b-i) nmttm<7>&-%5'Z.z 

ZcoMXlt^)X7t^m<^^{0. 0, 0.0, 0.0}, {5.0, 5.0, 10.0}, {10.0, 10.0, 5.0}^Jf 

*<7>f&&;&lc-$-;*.fcJi«U v£«U tt^ft ir<^^ft^ * t dbxm 8 ictfiL fc. 
[0 1 8 8 3 
[118] 





mm 








p, 


(0.0.0.0, 0, 0) 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 1 


p 2 


(5.0, 5.0, 
10. 0) 








p 3 


(10.0, 10.0, 
5. 0) 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 1 



[0189] 

(b-2) r = 4<7>3DDCS<7>4£/£ 

• =, -7 y y^lzis^X It. ffi<r)f$m*tfcdt>Z!%\zm^%WWi$.-&H-2.Z<& 1 g 
frih&o Z Z X\t^ comW1$. : %&& fzdb<7> V£M-&~t & . 3tftm3iX3hZ> 3D Discrete Clot 
hold Splinestt. j^fglc iir^ Wi^tl ») . ft * **46^ ^ «b ^ ^Si£iBt tc W L T rff «b ^ lc 

fft * x 0 2 0 <D J: 7 ft r =4<t> 3D Discrete C l o t h o i d Sp l i n e s <JO jK V =f > fF , ^3 
^biflT-ft^L/:, %Tz. % m \z Z co &$\\ J: *) 2 ti # '0 =f > 2 It, TB^<JO 

[0190] 



m 9 1 







p 






3. 1228} 




6. 2456} 




9. 4966} 


p 


/c n ^ o in ol 




Ifi 709S 6 709^ 
9. 9244} 




{8,0655, 8.0655, 
8. 4732} 




{9. 0327, 9. 0327, 
6, 7366} 


P 3 


{10.0, 10.0, 5.0} 



[0191] 

(b-3) mmi$. 

-^-h>. ^ -rv y tex-M ziziz. &&%t®i<F>mw<i.-%7ik%.'t z&^fr&z . 

3D Discrete Clothoid Sp 1 i n e s T tt v U * Hftft j)*~t T- lc Jf< * -o T v> S . d 
b -2T?£j£Lfc# =f> Q<7)i£<feff Jjft^l«I^ ? h ^ t J: *) >**7 > - 9 a 0 , b 0 ^5j<46§ 

K -b 7 > > h tc is u T . * <r> ft % x. £ 0 
[0192] 
[K4 5] 



u = i 



COS /? COS « 

sin j3cosa 
-sin a 



[0193] 

:ZT\ 3D Discrete Clothoid Splinestt. TI^ fc* VWM \z M ^ T* c t ^ # £ £ t 

, m 2 0 <7>^g 4 i + iTli . tt*ft^^»S**l/4T?*>S fcfiflSi-rs d i: fB]fitc^q 4 ( 

[0194] 



[146] 

aO^+ial^+^-l a2 4i =«0 4I . 1 



[0195] 

c co^ tt5fc*n»**a 1 4 j t a2 4 j<?>2)X7U3ijA^g^lc & o T 9 . cti^«uT^7 >- 
?ap a 2 ^«KfHI -t 3 o [s]«ic ^ ^ > - ? bp b^DIIt'i*ST-§ ^, 
[0196] 

[0197] 
[147] 



Ja' 2 + fi a cos 2 a 

A" - -5! 

ft 

[0198] 

[0199] 
[t4 8] 

V(fll 4 , + 2a2 4 ,) 2 +(61 4 , + 262 4; ) 2 cos 2 (a0 4j . +ol 4< + q2 4 ,) 

"4/ ~~ . ""' 



[ 0 2 0 0 ] 
[ 0 2 0 1 ] 

hbsic c^^vitc j: 9 :d< #> #i an m * ft i o tcie-t 0 

[ 0 2 0 2 ] 



[ft 1 0 J 



^ P,t P 2 t 


^0 


0. 0 (it 

in) 


a \ 


-0. 2684 


a 2 


1. 0739 


6c 


n /2 (gE 


A, 


0. 0 




0. 0 


h 


12. 7684 


& P 2 t P 3 t SrSS^ft 
ft 




-0. 1648 




3. 2061 


a?. 


2. 6327 


bo 


0. 7853 


b, 


0. 0 


b 2 


0. 0 


h 


9. 6752 



[ 0 2 0 3 ] 

(b-4) i'Stc^iS^l^ 0 2 iI^&3^7C ? n v K ffl^ 

(l)-2)T*aSL^|l]SljI^ffluTG 2 i^i: & § J; 7 i^frTT^I^'^ >- ?<?)fi 
flSUft % — ~ - h > ' v 7" V > lc J: oTlftS, C tllC i o TH b tl/i ^* 7 > - ? ^ b 3 

[ 0 2 0 4 ] 

i: £ 7 4'*frlcov^l#©=£*ftt%x^. 0 2 2lij&Pi. P 2 . P3<^3iX7C^nv 

aO j i: bO j tt ftt Ic fit *DT? ft £ «b . WSli> ft M C j <D ^ => > - ? a 1 j , a2 p blj. U\ 

, hp ft^C 2 <^ > - 7 a 0 2 ■ a 1 2 ■ a2 2' b0 2' b 1 2 • b2 2- h 2^ 1 2m b * * • W^lfe^tc 
T'T< 4)(?^^7 , A^ 'J ^h(l§ftI^)^^X^ 7° N \z n L T 9 . § ft jj$ \Z is It 

(9. v£8U ft^^ft!^^'^S(S^rafC i: L TPxj, Pyj, Pz r a,. 
(9 i . n j , /c j £ 7 [c ft t" » 
[ 0 2 0 5 ] 

[ 0 2 0 6 ] 

iX tc ^ P 2 ic o v^t -5 o ^P 2 lift^|B]±<^fSM^Tft *) x 0 2 31^lc * £ tc tiflg. Ji 
v£*§U ft^fc*]H5gf S'.&Sa**><5 « ^ * ^ ^P 2 lcfcv^T^ 9 3ao ^fr liTIfi^ J: 
7 ic & £ o 
[ 0 2 0 7 ] 



[S49] 



Px } (\) = Px 2 (0) 
Py t {l) = Py 2 (0) 
Pz,{\)^Pz 2 {0) 
cos[a,(l)-« 2 (0)] = l 

cos[A(i)-A(0)] = i 

n,(l).n 2 (0) = l 

/c,(l) = /r 2 (0) 

[ 0 2 0 8 ] 

£<^Ti^T<^5o<7)^ft^/j£9jyo 0 (3 3 ti . 4- £ s & j& tc 4? it § Jt m ~< t v 

[ 0 2 0 9 ] 
5 0 ] 

Px 2 (\) = Px } 

Pz 2 {\) = Pz, 
cos[«,(l)-a,] = 1 
cos[/? 2 (l)-/?,] = l 

[0210] 

W. _h ± 9 . * *n $C a 1 1 . a 2 j . blj, b 2 j . h j , a 0 2 , a 1 2 . a2 2 . b 0 2 ■ b 1 2 , b 2 2 , h 2 ^ 1 2 
ilcWLT, ^ # 5^ 14 T 12 <r> 1 2 flU *) aL o c i: fc* to fc* -5 = i 
T IS <?> <k 7 Jc * S o 
[02113 
[& 5 1 ] 

Px } (\) = Px 2 (0) 
Py } ()) = Py 2 (0) 
Pz l (\) = Pz 2 (0) 
cos[a,(l)-cr 2 (0)] = l 
cos[#(l)-/? 2 (0)] = l 
n, n 2 = 1 
*t,(1) = a: 2 (0) 
/'x 2 (l) = / , x, 
/> 2 (1) = ^ 

cos[«r 2 (l)-a 3 j - ] 
cos[£ 2 (l)-A] = l 



[0212] 



- - h > • ^ 7' v > vJ tc «k o T » § . » % ^ aft . Hi 1 k: 1W SB fll i: fl? % IB-t . 
[0213] 

[in] 









ft? 




l> 


o, o (I5E 
ft}) 






0. 2684 


-5. 4455 


a, 


1. 0739 


5. 4122 


u 


7C /2 

*n) 






0. 0 


-3. 8590 




0. 0 


3. 1003 


H 


12. 7684 


13. 5862 


C 2 


3 0 


-0. 1648 


-0. 033258 


**\ 


3. 2061 


3. 6770 


^2 


-2. 6327 


-3. 6437 


*0 


0. 7853 


0. 8120 


*1 


0. 0 


1. 6006 




0. 0 


-2. 4126 




9. 6752 


9. 2873 



[02 14] 

(b-5) mm<7>£.f& 

m 2 3 tt (b-4) -Z&dbfz'* 7 > - ? ^7Clc£fiK L fcftJj* i: b-2?£/j£ L =f> h * Is] 

[0215] 

(b-6) *f*^i:**nfC 

Z>« • ^ lc&3&^ tt*^$iJPi-S lc t k: i? it ft f*i 

El 2 4 tc^£ ft£ J: -7 tc MC^ffifM^StS =0. 5 <7)fi IE tc ^ D P i is St tc A L fc. U 
fcx ffi*&C 2 ,c ov^T t ffi*M«S =0. 5<^-feglc^DP 2 ^Sf fzlzffi ALtz. 
[0216] 

Z(DtB. t^DP^^S^tt^^ft^C ' ^ ^DP } i: ^P 2 **S #1*6 C ' 2 . ^ 

P 2 fc^DP 2 *JK^ttii6*ft*ftC ' 3. ^DP 2 fc^P 3 %Jfg4;ftifift*ftJj6C ' 4 t "T £ . M'&mmiz 

mmmmn a . p . mm. mm-z&m^m^m®. t ltpx c , py c , Pz c , a c .*9 c , n c , 

^ £ti ^ T* li P x s . P y s , P z s , a s , (9 s , n s . k s . ^ T* li P x e , P y e > P z e . a e . (9 e . n e . 

[0217] 

KIT ^ &;±Uc X JSft 9 3A o Ifi-t o 

[0218] 



[152] 

& p, : mm. mm. mm : Am 

cos[a c .,(0)-arj = l 
cos[^ cl (0)-/?J = l 
n cl (0)-n,=l 

: &u. mm. mm. mm :7m 

/>x c ,(l) = Px c . 2 (0) 
j Py c ,(l) = Py c . 2 (0) 
Pz c , 1 (l) = Pz c>2 (0) 
cos[« c .,(l)-a c . 2 (0)] = l 
cos[/? cn (l)-/? c . 2 (0)] = l 
n cl (l)-n c . 2 (0) = l 

«ci( 1 ) = «'<r2(0) 

^p 2 : mm. mm. mm -.im 

Px c , 2 (V) = Px c . 3 (V) 

^C- 2 (l) = ^C'3(0) 

/>z c . 2 (l) = Pz c . 3 (0) 
cos[a c . 2 (l)-a c . 3 (0)] = l 
cos[/? c , 2 (l)-/? c ,(0)] = l 
n c . 2 (l).n c . 3 (0) = l 

K c . 2 (\) = fC c , i (Q) 

&DP 2 : gt&. mm :7m 

Px c . 3 (l) = Px c . 4 (0) 

^C' 3 (l) = ^C-4(0) 

i>z c , 3 (l) = J Pz c . 4 (0) 
cos[« c . 3 (1) - a C4 (0)] = 1 
cos[/? c . 3 (l)-/? c . 4 (0)] = l 
n c . 3 (l)-n c . 4 (0) = l 
k c . 3 (1) = jc c . 4 (0) 

&? 3 -. &w. mm, mm, mm -.im 

Px c . 4 (Y) = Px e 
Py c , A (l) = Py e 
Pz ct (Y) = P Ze 
cos[a c . 4 (l)-a: e ] = l 
cos[/Wl)-/? e ] = l 

»c4( 1 )-n e =l 

/r c . 4 (l)=^ e 



[0219] 



_h «k *) . ^#Tj£9£o^#£#j$l;3:32fl?eT#>£o & ft Jjft **Jt o ? n y >f K 

^ > — ? tta 0 , aj. a 2 - b 0 , bp b 2 - ^7oo , oT'J> , ) 1 ^o, ft ^ ^*4^ ^ 
8ni28ffl£: L^L, 3 tlT li * ft & t * # ^ <?> » fc*^ L < * u<7> T* . fl? % J|<^ * d 
i:**tii*&i^ * C X%t Tz\zW A t ^o^DPp DP 2 ^ Y • zM1H^**n$: i: LT|i\ * 

[ 0 2 2 0 ] 

(b-7) 1WBI!«<oSi£2 

(b-6) T&Tfc&#j*%Sf -6 fc#MC- - - h > • 9 7' V >S£fcfflv*5 fc*. 

^<^iJXm*^_hi-f -5 fca6lc*^nSc^^^«^^^i-^o ^StLTii. HI 2 5 «k 7 iz (b 
-5) L fzV/KTt ?oV4F ft*fcfc*f L < f¥ A L ^ co m Xft $| -f & C i: [c J: *) . 3 

[ 0 2 2 1 ] 

ft*fc«>#9miCouTtt. ftttlCjfcftJjfcC ' i t ftlSC ' 2 ^ Kl^SO-tS^^^lft^-t* t 
. ftIC ' j<o? o'M F^7 ' , a ' 0 , a * ! , a * 2 - b ' 0 • b ' i • b ' 2 * ft B C 

1<? >^-7 > _ ? ^fflv^x . rm^x^xm^^. zzxs^t^wi^izisn^^mM^^xz 



[ 0 2 2 2 ] 





» 5 3 ] 


k 






= a \ s J 
















= b 2 S/ 




= hS d 



[ 0 2 2 3 ] 

WzfrWi&N i-ZtbgLt-? zmmt * 2 lcov^T^x§o £i\ ft^Cj 3 . 

TO C X ft § £ ft Ji$ * ft *ft C * * it-t&t. % <r> ft m It <ry 9 n y K => > - ? h * ' 
- a * * 0 . a * i > a * 1 2 , b * * 0 , b * * p b * * 2 ti . ftfcgC j tf> ft*&<7> ? > - 7 ^ffl 

[ 0 2 2 4 ] 

m 5 4 ] 
>;=p(i) 

a£ =a Q +a ] +a 2 -\-7r 
a"=-{a x + 2a 2 ) 

< 

b?=-(b : +2b 2 ) 
b" = 6 2 
** = /i 



[ 0 2 2 5 ] 



3<*>ffiJft±lciJV*T#9Jj&DPi»i. DP i =C ' ' i(l- SjlT^^S. C 3 T* ft It C ' * 
[ 0 2 2 6 ] 

3<^iiC2^^ov ^( K't7 >-?ti' ' , a ' 1 o , a ' ' j , a ' ' i , b ' ' q , b ' ' \ . 

b* ' 2 »±* ftjfiCo^^ ^ > — ?tfflv^TTie^)^T*i$n§, 

[ 0 2 2 7 ] 
[S5 5] 

«r=0-^rf){«i+2a 2 5 , </ } 
<bZ = b 0 +b l S <J +b 2 S </ 2 

6; = d 2 (i-s,,) 2 

/l" = Jl(l-S rf ) 

[ 0 2 2 8 ] 

W±.^^vSt. 3/X7c^o7^ Fftic^^ftiitS^s =0. 5-e*>s^DP 1 -ett*sc 1 

= 0.5-?*>Sj&DP2~?ffi*ftC2*ft*ftC' 3 C ' 4 ^ lc #9J § Z i: fc'T'i 3 . 
[0229]" 

3 <?>jjft T-^SIJ L 4o co ftH<7) ^ 7 > - ? £ft 1 2 \z itfc. 3 <7)flJj6<?> => > - 57 
% b-6 T? T * 5* * it tz f » % ^ 56 £ ^<7> - - - h > • 9 -7 V > v£ *>#J»lfft lC ffl V> 

o 

[ 0 2 3 0 ] 



[ft 1 2 J 



till tlk 


u 


o.o (gE&O 




3 0 


4. 9134 


c ' , 


i 


-2. 7227 


C 2 


a \ 


-0. 016629 




*2 


1. 3530 






1. 3530 




K 
\) 


7C /2 (ftftl) 




b 0 


0. 41633 




b l 


-1. 9295 






-0. 37938 




b 9 


0. 7750 






0. 77507 




h 


6. 7931 




h 


6. 7931 






{0. 0, 0. 0, 0. 0} 






{1.8431, 3.0860, 
4. 9597} 


lllj %k 




-0. 033258 






7. 1774 


C ' 3 


a, 


1. 8385 


c 4 


a \ 


0. 016629 




*2 


-0. 91093 




a 2 


0. 91093 




A) 


0, 81202 




b Q 


1. 0091 






0. 80031 




*i 


-0. 40601 






-0. 60316 




b 2 


-0. 60316 




h 


4. 6436 




h 


4. 6436 






{5.0, 5.0, 10.0} 






{7.0029, 8.1298, 
7. 5337} 



[ 0 2 3 1 ] 

( b-8) 4kft-&mtz-t ? n V -i K v > - ? ^;d<#> § 

(b-7)-?i*£LfctJ8!fft*7Ck:. (b-6) T-iaT fc&#j**iif - - - N > • v 7* v 

>^T?^*>fc. ^ 1 3 liSft 3 ftfc&ftJjfc^^ 7 > - 9 ~Z3bZ>o * fc. ft 1 4 \t*fZ.fzi$. 
t±j&2 ft ft • *£;&*>JiiMU ftf^it^Lfct^T-J)^. 

[ 0 2 3 2 ] 

[ii3] 





a 0 


0.0 (EEfcO 




a 0 


5. 3846 




0. 0000 


*i 


-3. 4602 


^2 


-0. 89854 


a 2 


4. 341 


K 


tl/2 (UEfti) 


A) 


0. 47690 


bi 


-0. 51836 


A. 


-3. 2143 


b 2 


-0. 57552 


*2 


3. 4613 


h 


5. 1836 


H 


9. 9808 




{0.0, 0.0, 0.0} 




{1.8431, 4.1726, 
1. 4653} 


fSl C 3 




-0. 017740 






6. 8553 




3. 4572 


a i 


-1. 1443 




-2. 8673 


^2 


0. 57219 




0. 72385 


K 


0. 76315 




2. 4551 




-1. 1942 




-2. 4158 


£ 2 


0. 43108 


h 


6. 60818 


h 


3. 3206 




{5.0, 5.0, 10.0} 




{7.0029, 9.0734, 
5. 6186} 



[ 0 2 3 3 ] 



[ft 1 4 ] 













Pi 


J /*— lie. 


{0.0, 0.0, 0.0} 


{0.0, 1.0, 0.0} 


{1.0, 0.0, 0.0} 


0. 10 


^fiSc**!^ «fc 
5{ff 


{0. 0, 0. 0, 0. 0} 


{0. 0, 1. 0 0. 0} 


\\ 0 0 0 0 0) 


0. 10 


HE 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 


p 3 




{ 10. 0, 10. 0, 5. 0} 


{1.0, 0.0, 0.0} 


{0.0, -1.0, 0.0} 


0. 10 




{10.0, 10.0, 5.0} 


{1. 0, 0. 0 , 0. 0} 


{0.0, -1.0, 0.0} 


0. 10 




{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


{0.0, 0.0, 0.0} 


0 



[ 0 2 3 4 ] 

(b-9) mm<n±r& 

(b-8) X'^dbfz^ *? > - 9 \z «k *) ftfcftJfifcig 2 6 \z^-f„ H ifift 3 iX 7C ? n V >f 

=> -7 * m-f . £ 3 ft li s ft 1 2 i 7 C4£t*frtifcLTv^ c t 

fc> <g> o 
[ 0 2 3 5 ] 

#0 * IB L . 
[ 0 2 3 6 ] 

3. 3 ^tu f a v >f H ffir^fflu/citMJiP^ 

xiq^s^tu? n v >f Kawi&«ui. xft»to<?>xs***>fk*>»imm&*>aiftfiHiap 

[ 0 2 3 7 ] 

(1) 3 YKJt ? n 7 >f H ffifflfcfflv^fc&fftftjffl];^ 
[ 0 2 3 8 ] 

(j)IlIifli^)M(@2 8, SI) 

hf^IMi'KtS, f^II^ftl^ (II,>S, tool center point) l$¥m%)£>& 

ki'-eSi. XMj£*>&HI±. M*£ (x. y. z) T-ft£ft. Xfl^^fltt * #0 x. it x 
. y. z Sfft£ *i§o if <?> «k 7 %nn%M£ ft . XMj&*>»i8*tt& 

t7jft&^ftk:«:s ci t & < . mmm iz m** o t us o jst&fajap^n 1 Ma, c 

JlStt * . 3 iX7C ^ n V >f K ftH ic Stf ~t & Z t \z 3b & . 
[ 0 2 3 9 ] 

(b) MM$imn MX ltdb ( 0 2 8 . S2) 

-WtftizitmmizHLxmfeziizm&fr^^t)*. m^itmmmx^-t ^h^m 

frXl$MjMX°&M£ *x ft 6*0 T v^S gP^T* liftlT-ifil $ i: 7 Wit ^ «b . #L» 

[ 0 2 4 0 ] 



^mnmmizis^T it. ummiznm $ nx^ zn^nm^tesm^nm-? z ° 

it. n^T'Suic i&^-t s x . y. z cr> 3 i&^m^^T ^ < 3 'Ajtmm&x* & *) . x 

[ 0 2 4 1 ] 

(c) mfrrn (02 8. S3) jkv * >i ^ ~> -r > mm&\z & & xm?> & • ^m<omn ( 

0 8. S 4 ) 

I-^lit)^Wt<7)ra»i:LT4i.'bnfeCt}c=5:S. 3 ft lc J: 0 . Bf ffl t £ «K X Bf n 
PST'4x/ct§, ^ft^ft^Bf ^JicM-tSXM *^te£X#>S 3 i: So (c)<^tf 

gti, M#i£nc liJ^T^) J; i \zif &;bftSo Mte&lz fci^T it . -fig'Ht IS^Jf m . 

^ > - 9 \z j: , 3M'&<7>&izs5rt z&w.mm^>mm. tti^t^ittit^ci:^ 

[ 0 2 4 2 ] 

Wl^flctlCioT, ^7 >l t x T >J«^ (H^W) IC It S Bf fiH t tCxftSXM 
;£<7Mig .X#§t**f+g £ ft S » t L T li . 3^7tT-li (x, y. z. A. m . v. 9 

) i: & 5 o £ L , ( A . m x v . 9 ) li ^£|E % ^ fffi 0 IteT? H L t <?> T* ( A * m . y 

[ 0 2 4 3 ] 

Ufc. 8tfifrJfi^<bc7>^j|Uc «k 9 . 3}X7n?n v >f KiiiSticTftoT, <* ft ^ it 
£^-v££l+ * ^ -b -y h L -b >v h &-&^dbT . ZTl^Jj v 9 - >t * ( XM 4"ll^fLl?# 

[ 0 2 4 4 ] 

i\)*tmMM (028. S 5 ) 

K\z. Xie^XM^^fiE • '£M"k^z. S fz db lz>&m%& Mb to \*lffiin ^X^S . c^il 
— J&lcitf&fltfl? ( inverse kinematics) t Df li ft T u S . 00 ^. 1* 6 $i<?> a # >v h 

10ft*6o$,^^T\ m<7)HIH. 8iS<7>WfflK Z>i;<7>WftK X M <7) W IP W fc* M 
SSiLt^T'II^^fil • Iii s i^l5. 3 ti**IK*8l«l» ^ of litis. i#*&#flm. 
cftMilxtttcfl&c^rl^firB • ^^^^$6^f^<7)0$E^ 9 1 — 0 6^X#>St><7>X£> 
So grMlcOT ? * ~ ^ - 9 ItMlfc^- 9 ~Z*db& bltm^-f . ')^7t-?f^)Ii7^f 
-i-?T-i)^J|^t*l,^, -f-^Jt^T^filRRia-^^te^ 'UTt-^A^J'H^ 

sictit^tf ^f7^) B xi^f t *So n # >v h i^ii^ir izm 

* * <JO T- . |i^BiK';MCouT flS SO lc ft % ffl ig L T 4? < . 
[ 0 2 4 5 ] 

(e) t&mm&lz «k S ^-fit- ?^te<off-B (02 8. S 6 ) 

nf y>SU 5 tifc#II*lco cti^^li^-^ ( g. dj-t ^ ^ ^_ ? 

^#t?) ^^fiM-ixtLTltftt^. ^mmT'tc^Mtilz it. fi^i^5> 

[ 0 2 4 6 ] 

±ie x umu (b) itmnftK^mxab *> . -mfinn ^^tis 0 uwcem. »£<**i 

[ 0 2 4 7 ] 

±se<^^T<^g+S^ . MftlJimgcT^T-ff 7 z t t DTrllT-^ *) , *>SvMi. (a)^V( 
b) ^SUco =1 y v =l - 9 (ffffft) lc j: 0 stMJkvWtfe LTfc § . ^ <r> \&m X s ? > - ^ tr 
^iCffifOil^glcK 0 (c)-(e)wtI^M|ji^IrtTlT7:ttT'S5. 
[ 0 2 4 8 ] 



( 2 ) N C^g^ C N C fig 

n > - - 9 t n c mu t ti^ c n c mw.*i$.m-t zmtnz-? i^nt§. 

(a) jsfei^NCHBSffluSS^ 

^Bt 3 tlT & . f tllcJILT, Ifi^CNCillSTii, 77 ^> r^lf 7 n> 

-?t±NCf|glcftM£tiT. — ^ft^tltt^kftoTv^. 
[ 0 2 4 9 ] 

* -f . ifu % 8ii<?)NC^iatfflv^i|^lcov^T. 3 iX7C ? n vM h* ic «k * » 
§P7? i^tlHi" -5 o c^Jt ^-. ? p y ^ K t - ? tti L li ? p V K a- 7 > - ? $ 
fflv^t^t L, G 3 - H CO rfJ ic ? a V >f H <7> 7 * - v V t^#t £ o C tl It M It . 
iX co =k 7 & <b Ti> S o 
[ 0 2 5 0 ] 

G *fc ^ 

AO, Al, A2, BO, Bl. B2, H 

G * * * li G 3— H <7>S-^*^-t. AO^Htt 3 #J7C * n v >f k «te r > > h <t> 7 
>-?^^f„ C <?> n — H ^Htf i" -5 ifu IZ. IMliP 0 ^)fiIlc*Ti^. NC 

> - 9 ^ffl v^T . 8#Bf <^IMfig * til M fi g <?"> 3£ t> ^ f+ S L TUff 

ts. rmmi ti^. ab#*n c^gfjj-eff ^liiif - ^T^Mft^K <* 

n V ^ft^l)" 5 C £: ic J: o T x fiS^<^NC^glC ? n V >f K ft jf$ * ffi A jA t? C i: ^HJ^ 

[ 0 2 5 1 ] 

(DCNC 7^ 

■7" a r ^ v <?> J# o n > ^ ~ - ? fcNC^Hi:<7>-#fl:3*ifcCNC^H*>#£- 

ICov^TI^So 3 ^Jf^-. ? a V >f hMC $ *t & If tcn^^co ^- H T?ff t> tl S *Mi 
H lc ft <b * . £ , T'-^^I^il^xf- HtfS^^tno^^, 
[ 0 2 5 2 ] 

— )S£ ic. d <t> 7' a 7 7 v tc fl . * tl f tl <t> * ft \z m L ? a v K cn ^ => > - 9 & y£ ^ 
i--5iS^^# Uti*. 3 ft* Til^J tin. il^^^tctt. #ijxti. < o fc> » Sc ft 
ft j&?!J * 4 x. T . 3ft ^**MStcilS>#^ ^fttt^*tfSi-£ ^7 A ( @ i^^J 
ffiffl) t # litis. /jnli^f i: ^5llfi»^ft£7'p 77 A (v>;b «> § C AM 

) «b#*ft5 3 t ^#v^„ 
[ 0 2 5 3 ] 

( 3 ) 3 iX7C* n vM H ffim*fflv^fc8C«ftiJ8P^^<7>!|f gC 
[ 0 2 5 4 ] 

> - 9 tc j: ^^^.^tiTv^s x7 - 7 -r > ft $ ft £ ' <jo ffe<5o m m x° it . &m 

[ 0 2 5 5 ] 

3 tl * S \z , 02 9lc^^ti^Jc7lc. x 7° 7 >f > ttifi R ( t) T-^m $ tl & tfift 

m^MiH-t % tB . m^mmm'ikcoxmco^mm. a s a*, ^itt t at ^ 

i:^i»Ifc^lc|l8ftt« ! t^?l±4v^-?, J* 3a £ & ^ fb» A t l± it iz it ^ * 3 
tttTJl4v>. R 0 + AS = R ( t o+A t) ^)^«*v^T A t *^«>4{t*itt, 
tlffit^: h<)»T'§^i^T\ m W c If S * ^ *) M 5 ft it ti ft ^> ft 



d t \Z £ -5 o 
[ 0 2 5 6 ] 

(b) V/Kit 9 a V A H ft^T-fl. til » j| tc jrt i" § ft * <^ ^ ft^ ft 7? , 1&®m\z-feX* 3b 

^^'Srv^iJP'li^ t z\ t ;b*ai!ff£ ti-So -®.co irT-fl. ftMX^r 

^10 • ftOPf -5 c t « Bi?J> £ . 
[ 0 2 5 7 ] 

(c) 3 Kit ? a V K ft;Hfl. *<7>mft%M&£ LT, ii.«L P3 # . 4£ ft & ir £ # 

ilt £ 3 £ **tii*^.„ 
[ 0 2 5 8 ] 

(d) 3^tu ?n'MH ft *ft fl m m $i ^ t *) ft\z J; ^> &u g . x, y. zfiTft 
lA»i^^i*wNCglT'tt, 00 fl *7 - ? ^ f4 36 tc ftl It T m X i" § i: £ \z , n - ? 
co SX v ft It ft \z J; o T fl . n 36 ^ m 1}U X L -f o £ 0 . ^nlLlc < ^ofc 1 ) t 

-5 . 3 7U 9 a V H ft m T* fl . ft H 4% [C J; o T -4 £ h fl § <^ T * $1 36 <7> ffl £ fiB 
X-tSiS^-T^. f436^ffiXlc#i»^ fF/&-t*ifl\ *¥ffifc/mX-t 5<o £: im*ilc*jnXT£ 

[ 0 2 5 9 ] 

&fc*£MH<7K }f *ft^l«I<7> ^ v ^ft is £ V 3 -ft co^c ti^fi^mmM * flft*U*^Sc 
^)l)XitT*4ibtl^3»;7UttI ( 3 #C7C * n vM h'ftihv^) ^ffl v^TX S #l» £ 
fl "7 - ? <7>$&f|^;t^ H M~t 7 7 A * n > tf a. - 9 TUff i" § RSlc tt . 3 > tf ^ - 

9 <7>'^ — h'f -f X ? ^ g#<7>ii|/j|e'H^g [c 7° n r ^ A £ &#| LTfe§> M > > t '1 - 
lcn-F LTHtftS. f^J:7*^nr7Ali, C D - R 0 M W^^SmmmUm 

frlc^n /7i,§^iLT^MLfc 0 . *v V *7 - 9 % /h L T ijro 3 tl n > tf ^ - 9 co 
tZ&W. W. IZ L T § . ^ -y N -7 — ^ ^ a i: T ffc<7> =i > t° a. - 9 iz ilf ^ Z t «fc T* § 
S. -f<^ «k 7 * 7'n AlC =k (3 /yvTU ^ a V -f K ft ifift <7> ft *ft ^ 7 > 

- 9 . ?<7>^fi^^u CD-R 0M^^Hr^Mie^^#lC5f§*fl LT^St 

[^^X^fiJfflHTftltt] 
[ 0 2 6 0 ] 

*^BH<^ 3 /yvTC ? n v ^( h' ftl^lc J: tiflx X^M n a o<7>^s+XMlc^W i: & S^Wftfc&tf) 

[Elffi^ffim'Srl^BH] 
[ 0 2 6 1 ] 

[01] x. y IHI^ 2 ^ o V -i F ttS^^tm. 

[02] 2iX7E^n V ^ Hftit^tH. 

[0 3] 3iX7U^n'M Kfti^)a, 

[04] AMKJ 3 Kit 9 a V >f H ffii^itt^tio 

[05] g 2 mm%mmm&ft-$:^~tm« 

[0 6] g»fffi<olt4^t0. 

[0 7] ^ a V >f H SiM<^^vi^iStti<^*^*^-tl3. 

[0 8] G 2 jgM fc «k 7 =5r*fr^iS^-t fflra^¥vi<50ifi£n<?>«lS^^ 
t0. 

[0 9] ^Pj, P 2 . P3<?>3iX7U^ a V -f Flit^tlll, 
[010] r =4<7>3D Discrete Clothoid Sp 1 i n e s % 5jk i" 0 „ 
[0 1 1] 3D Discrete Clothoid Splines^f£Bfli--£,0 o 
[0 1 2 ] fflP^lc J: *) Xl^^ tl/i3/yv7U ^ a v K 



[016] nisicffifflfcff-Dfc*e*fc^-*ei. 

[0 17] &ttJfc*>%j&^<b<?>»tm*l t ft*<?>M#^ 7^ 7 0 

[0 18] *ra^JcUttS«^ftiJiSBJ^^-tl3o 

[0 19] M • 3^7U * n V >f H £ fl! V * *t W <*> ft£ tt<7> « 

?*^i"0o 

[0 2 0] r = 4^3D Discrete Clothoid Sp 1 i n e s % ^i" 0 „ 

[021] 3 *l Tz # =f > * ^"t 0 . 

[0 2 2] ^Pj, P 2 - P3^3^7U ? n V >f K ffiit^t0, 

[0 2 3] tlfcttJjft i: # V =f > i: 

[0 2 4] ^ttf AL t0o 

[0 2 5] ftWl £ ftfc3iX7C 7 a v -f H fti^^tH. 

[0 2 6] 4^$tltftit^t0o 

[0 2 7] ^ft^M^^MMs mm K <7>M^*^-t 77 7 0 

[0 2 8 3 ^mmm^^^^-txnm, 

[0 2 9 3 ^ ^ 4 > Eft!t^^-tJ:blX0o 



[mm%] mm 
im 1 ] 




x 

[0 2 ] 



2 a v -f K 



[05 ] 

G2»«3S:tilllI*fTa(=I±TIB©ft#*»lfc-ri&K^ft*. 




[m 7 ] 



STEP1 







STEP2 


3 '-kltt a y 
















■ fiat Ufa 



[0 8 ] 



Witt: 3 ^ o V 



STEP 3 



^Mft 3 ^ 









► 




► 













[m 9 ] 



Pi 
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